<?xml version='1.0' encoding='iso-8859-1'?>
<!doctype html public '-//W3C//DTD XHTML 1.0 Strict//EN' 'http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd'>
<html xmlns='http://www.w3c.org/1999/xhtml' lang='en-us'>
	<head>
		<title>
			mdioblock2.c
			</title>
		<meta http-equiv='content-type' content='text/html;iso-8859-1'/>
		<meta name='generator' content='motley-tools 1.9.4 13:40:33 Feb 18 2015'/>
		<meta name='author' content='cmaier@cmassoc.net'/>
		<meta name='robots' content='noindex,nofollow'/>
		<link href='toolkit.css' rel='stylesheet' type='text/css'/>
		</head>
	<body>
		<div class='headerlink'>
			[<a href='manifetch.c.html' title=' manifetch.c '>PREV</a>]
			[<a href='toolkit.html' title=' Index '>HOME</a>]
			[<a href='mdioblock.c.html' title=' mdioblock.c '>NEXT</a>]
			</div>
<pre>
/*====================================================================*
 *
 *   Copyright (c) 2013 Qualcomm Atheros, Inc.
 *
 *   All rights reserved.
 *
 *   Redistribution and use in source and binary forms, with or 
 *   without modification, are permitted (subject to the limitations 
 *   in the disclaimer below) provided that the following conditions 
 *   are met:
 *
 *   * Redistributions of source code must retain the above copyright 
 *     notice, this list of conditions and the following disclaimer.
 *
 *   * Redistributions in binary form must reproduce the above 
 *     copyright notice, this list of conditions and the following 
 *     disclaimer in the documentation and/or other materials 
 *     provided with the distribution.
 *
 *   * Neither the name of Qualcomm Atheros nor the names of 
 *     its contributors may be used to endorse or promote products 
 *     derived from this software without specific prior written 
 *     permission.
 *
 *   NO EXPRESS OR IMPLIED LICENSES TO ANY PARTY'S PATENT RIGHTS ARE 
 *   GRANTED BY THIS LICENSE. THIS SOFTWARE IS PROVIDED BY THE 
 *   COPYRIGHT HOLDERS AND CONTRIBUTORS &quot;AS IS&quot; AND ANY EXPRESS OR 
 *   IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 
 *   WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 
 *   PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 
 *   OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 
 *   NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 
 *   LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 
 *   HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 
 *   CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE 
 *   OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 
 *   SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.  
 *
 *--------------------------------------------------------------------*/

/*====================================================================*&quot;
 *
 *   mdioblock2.c
 *
 *   Contributor(s):
 *      Charles Maier &lt;cmaier@qca.qualcomm.com&gt;
 *
 *--------------------------------------------------------------------*/

/*====================================================================*
 *   system header files;
 *--------------------------------------------------------------------*/

#include &lt;stdio.h&gt;
#include &lt;ctype.h&gt;
#include &lt;unistd.h&gt;
#include &lt;fcntl.h&gt;
#include &lt;sys/stat.h&gt;

/*====================================================================*
 *   custom header files;
 *--------------------------------------------------------------------*/

#include &quot;../tools/getoptv.h&quot;
#include &quot;../tools/endian.h&quot;
#include &quot;../tools/number.h&quot;
#include &quot;../tools/chars.h&quot;
#include &quot;../tools/error.h&quot;
#include &quot;../tools/flags.h&quot;
#include &quot;../mdio/mdio.h&quot;

/*====================================================================*
 *   custom source files;
 *--------------------------------------------------------------------*/

#ifndef MAKEFILE
#include &quot;../tools/getoptv.c&quot;
#include &quot;../tools/putoptv.c&quot;
#include &quot;../tools/version.c&quot;
#include &quot;../tools/error.c&quot;
#include &quot;../tools/todigit.c&quot;
#endif

/*====================================================================*
 *   program variables;
 *--------------------------------------------------------------------*/

static signed c;
static unsigned row = 1;
static unsigned col = 1;
static uint16_t count = 0;
static uint16_t instr = 0;
static uint32_t addr;
static uint32_t data;
static uint32_t mask;

/*====================================================================*
 *
 *   signed mygetc ();
 *
 *   return next input character after updating the cursor position;
 *
 *--------------------------------------------------------------------*/

static signed mygetc ()

{
	extern unsigned row;
	extern unsigned col;
	signed c = getc (stdin);
	if (c == '\n')
	{
		row++;
		col = 0;
	}
	else if (~c)
	{
		col++;
	}
	return (c);
}

/*====================================================================*
 *
 *   uint32_t integer (unsigned radix);
 *
 *
 *--------------------------------------------------------------------*/

static uint32_t integer (unsigned radix)

{
	uint32_t value = 0;
	unsigned digit = 0;
	while ((digit = todigit (c)) &lt; radix)
	{
		value *= radix;
		value += digit;
		c = mygetc ();
	}
	while (isspace (c))
	{
		c = mygetc ();
	}
	return (value);
}

/*====================================================================*
 *
 *   void assemble (flag_t flags);
 *
 *   read stdin and write stdout; convert hexadecimal input to binary
 *   MDIO register instructions;
 *
 *   the input file consists of zero or more hexadecimal instructions
 *   consisting of register address, register data and register mask;
 *   instructions are terminated with semicolon; fields are separated
 *   by white space; scriptstyle comments are permitted between
 *   instructions but not between instruction fields;
 *
 *   the output file will consist of one 16-bit program header plus
 *   nine 16-bit MDIO instructions for each input instruction; the
 *   output is padded to the nearest multiple of 32-bits;
 *
 *--------------------------------------------------------------------*/

static void assemble (flag_t flags)

{
	c = mygetc ();
	while (c != EOF)
	{
		if (isspace (c))
		{
			do
			{
				c = mygetc ();
			}
			while (isspace (c));
			continue;
		}
		if ((c == '#') || (c == ';'))
		{
			do
			{
				c = mygetc ();
			}
			while (nobreak (c));
			continue;
		}
		addr = integer (16);
		data = integer (16);
		mask = integer (16);
		instr = MDIO16_INSTR (1, 1, (0x03 &lt;&lt; 3), 0, 2);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		instr = HTOLE16 ((addr &gt;&gt; 9) &amp; 0x03FF);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		instr = HTOLE16 (0xFFFF);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		count++;
		instr = MDIO16_INSTR (1, 1, (0x02 &lt;&lt; 3) | ((MDIO32_LO_ADDR (addr) &amp; 0xE0) &gt;&gt; 5), MDIO32_LO_ADDR (addr) &amp; 0x1F, 2);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		instr = HTOLE16 (data &amp; 0xFFFF);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		instr = HTOLE16 (mask &amp; 0xFFFF);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		count++;
		instr = MDIO16_INSTR (1, 1, (0x02 &lt;&lt; 3) | ((MDIO32_LO_ADDR (addr) &amp; 0xE0) &gt;&gt; 5), (MDIO32_LO_ADDR (addr) &amp; 0x1F) | 0x01, 2);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		instr = HTOLE16 ((data &gt;&gt; 16) &amp; 0xFFFF);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		instr = HTOLE16 ((mask &gt;&gt; 16) &amp; 0xFFFF);
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
		count++;
		if (_anyset (flags, MDIO_VERBOSE))
		{
			fprintf (stderr, &quot;REG=0x%08X DATA=0x%08X MASK=0x%08X\n&quot;, addr, data, mask);
		}
		if ((c == ';') || (c == EOF))
		{
			c = mygetc ();
			continue;
		}
		if (_allclr (flags, MDIO_SILENCE))
		{
			error (1, 0, &quot;Illegal character or missing terminator: line %d col %d&quot;, row, col);
		}
	}
	return;
}

/*====================================================================*
 *
 *   int main (int argc, const char * argv []);
 *
 *
 *
 *--------------------------------------------------------------------*/

int main (int argc, const char * argv [])

{
	static const char * optv [] =
	{
		&quot;qv&quot;,
		&quot;file [ file ] [ ...] &gt; file&quot;,
		&quot;Atheros Clause 45 MDIO Instruction Block Assembler&quot;,
		&quot;q\tquiet mode&quot;,
		&quot;v\tverbose mode&quot;,
		(const char *) (0)
	};
	flag_t flags = (flag_t)(0);
	optind = 1;
	while ((c = getoptv (argc, argv, optv)) != -1)
	{
		switch (c)
		{
		case 'q':
			_setbits (flags, MDIO_SILENCE);
			break;
		case 'v':
			_setbits (flags, MDIO_VERBOSE);
			break;
		default:
			break;
		}
	}
	argc -= optind;
	argv += optind;
	if (isatty (STDOUT_FILENO))
	{
		error (1, ECANCELED, &quot;stdout must be a file or pipe&quot;);
	}

#if defined (WIN32)

	setmode (STDOUT_FILENO, O_BINARY);

#endif

	instr = MDIO16_START (1, 0, count);
	write (STDOUT_FILENO, &amp;instr, sizeof (instr));
	if (!argc)
	{
		assemble (flags);
	}
	while ((argc) &amp;&amp; (* argv))
	{
		if (!freopen (* argv, &quot;rb&quot;, stdin))
		{
			error (1, errno, &quot;%s&quot;, * argv);
		}
		assemble (flags);
		argc--;
		argv++;
	}
	instr = MDIO16_START (1, 0, count);
	addr = count * sizeof (instr) + sizeof (instr);
	if ((addr % sizeof (uint32_t)))
	{
		uint32_t pad = 0;
		write (STDOUT_FILENO, &amp;pad, sizeof (pad) - addr % sizeof (pad));
	}
	if (!lseek (STDOUT_FILENO, 0, SEEK_SET))
	{
		write (STDOUT_FILENO, &amp;instr, sizeof (instr));
	}
	if (_anyset (flags, MDIO_VERBOSE))
	{
		fprintf (stderr, &quot;%d instructions\n&quot;, count);
	}
	return (0);
}


</pre>
		<div class='footerlink'>
			[<a href='manifetch.c.html' title=' manifetch.c '>PREV</a>]
			[<a href='toolkit.html' title=' Index '>HOME</a>]
			[<a href='mdioblock.c.html' title=' mdioblock.c '>NEXT</a>]
			</div>
		</body>
	</html>
